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基于 ORB-SLAM2 的 实时 网 格 地 图 构建 
陆 建 伟 ， 王 兆 力 " 


(太原 理工 大 学 信息 与 计算 机 学 院 ,， 太原 030024) 


摘 要 : 针对 目前 视觉 SLAM 系统 只 能 输出 相机 的 运动 轨迹 图 ， 而 不 能 生成 用 于 路 径 规 划 和 导航 的 地 图 的 缺点 ， 提 出 
了 一 种 基于 ORB-SLAM2 的 网 格 地 图 实时 构建 算法 。 首 先 ,建立 了 一 个 适用 于 视觉 SLAM 的 逆 传 感 器 模型 inverse sensor 
model，ISM); 其 次 ， 针 对 ISM 模型 ， 重 新 编排 了 网 格 地 图 工法 的 构建 机 制 ， 并 对 其 进行 详细 的 推导 ; 最 后 ， 介 绍 了 
ORB-SLAM2 网 格 地 图 构建 的 具体 实施 方案 。 通 过 实验 , 对 ISM 模型 和 网 格 地 图 模型 进行 分 析 ， 确保 了 算法 的 可 行 性 ; 
用 单 目 相 机 和 RGB-D 深度 相机 进行 实时 实验 ， 实 现 了 网 格 地 图 的 实时 构建 ， 且 能 够 清晰 地 显现 出 障碍 物 位 置 ， 验 证 
了 所 提 算 法 的 有 效 性 。 
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Real-time occupancy grid mapping using ORB-SLAM2 


Lu Jianwei, Wang Yaolii 
(College of Information & Computer Science, Taiyuan University of Technology, Taiyuan 030024, China) 


Abstract: Currently the visual SLAM system can only output the camera's motion trajectory, but it cannot generate maps for 


path planning and navigation. In order to solve this problem, this paper proposes a real-time grid map algorithm based on 
ORB-SLAM2. Firstly, the paper establishes an inverse sensor model (ISM) for visual SLAM. Secondly, the paper 


rearranges the construction mechanism of the grid map algorithm for ISM model and then derives it in detail. Finally, the paper 


introduces the specific implementation Scheme of ORB-SLAM2 grid map construction. Through experiments, the algorithm 


shows its feasibility based on the analysis of the ISM model and the grid map model. Furthermore, the real-time experiments 


using monocular camera and RGB-D camera can realize the real-time construction of the grid map and clearly show the 
positions of obstacles, which verifies the effectiveness of the algorithm. 


Key words: ORB-SLAM2; inverse sensor model; grid map; RGB-D camera 


因此 ， 在 SLAM 领域 分 化 出 了 一 个 新 的 区 域 一 一 V-SLAM。 在 
V-SLAM 中 ， 比 较 流行 的 系统 有 MSCKF Pp] 、ROVIO 6-4 、 
同时 定位 与 地 图 构建 (simultaneous localization and OKVIS 5 、ORB-SLAM2 [6-71 、VINS-mono [3] 等 ， 但 是 这 些 


mapping，SLAM)) 是 机 器 人 和 自动 导航 中 一 个 十 分 重要 的 领 ” SLAM 系统 并 没有 在 真正 意义 上 实现 建 图 功能 ， 只 是 简单 地 输 
域 。 它 是 在 没有 环境 先 验 信息 的 情况 下 ， 通 过 自身 的 传感器 ， 出 一 个 相机 运动 轨迹 图 ， 而 在 实践 中 ， 相 机 的 运动 轨迹 图 并 不 


0 引言 


在 运动 过 程 中 建立 环境 模型 ， 同 时 估计 自身 运动 。 在 智能 领域 。 能 够 用 于 机 器 人 导航 和 避 障 。 

中 ， 从 简单 的 扫地 机 器 人 ， 到 复杂 的 自驾 汽车 ，SLAM 都 是 一 Santana 等 人 四 在 2011 年 介绍 了 一 种 基于 单 目 相机 使 用 平 
个 必 不 可 少 的 组 件 。 无 论 是 自主 四 旋 辟 无 人 机 探索 恶劣 环境 ， 重信 息 ( 单 应 和 矩阵) 构建 2D 地 图 的 方法 ， 该 方法 在 分 割 步骤 
还 是 自动 驾驶 汽车 ， 自 动 导航 和 建 图 已 成 为 诸多 应 用 的 基础 支 ”通过 判断 图 像 特征 点 是 否 在 同一 平面 来 快速 判断 是 否 有 障碍 


li 
撑 。 所 以 ， 一 个 高 效 的 机 器 人 导航 和 地 图 构建 是 科研 人 员 一 直 ” 物 ， 但 是 由 于 单 目 视觉 没有 尺度 信息 ， 所 以 建立 的 2D 网 格 地 
追求 的 目标 。 尤其 是 最 近 几 年 , 这 已 成 为 一 个 快速 发 展 的 领域 ， 图 并 不 适用 于 现实 中 机 器 人 的 定位 和 导航 。Dia 等 人 mo 介绍 了 
取得 了 许多 重大 的 进展 。 目 前 ,虽然 有 用 LiDAR 作为 3D 传 ”一 种 新 型 的 用 于 占有 网 格 地 图 的 逆 传 感 器 模型 ， 然 而 并 没有 
感 器 的 SLAM 系统 凹 ， 而 且 在 室内 环境 应 用 已 不 具 任 何 挑战 ， SLAM 方面 的 应 用 。Hullr 介绍 了 一 种 基于 LSD-SLAM 的 实 
但 是 这 种 高 成 本 传感器 限制 了 其 不 能 够 在 低 成 本 系统 中 应 用 。 时 占有 网 格 建 图 , 与 文献 [9] 类 似 , 实现 的 单 目 SLAM 的 构建 占 
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用 网 格 地 图 算法 ， 它 是 通过 把 点 云图 投影 的 方式 实现 了 网 格 


框架 ， 是 一 种 


够 创 


建 相 对 简 


图 的 构建 。Gregorio 等 


大 ， OE 
占用 太 多 的 资源 。 

ORB-SLAM2 是 一 个 比较 流行 的 V-SLAM 系统 ， 
单 的 3D 点 云图 ,1 
于 机 器 人 的 路 径 规划 和 导航 。 


也 
介绍 了 一 个 高 效 的 机 器 人 导航 建 图 
3D 的 占用 网 格 地 图 构建 算法 ， 但 是 太 


其 计算 量 


该 系统 能 
是 这 个 点 云 地 图 并 不 能 
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p(r|z)=p(r|m =OCCA^m, = EMP) G3) 


考虑 m 存在 的 所 有 可 能 的 状态 ， 可 得 


plrlm =0CC)= 
5 (p(rlm=0CC,M, )xp(M, Im=0cc) ® 
人 


7 


其 中 : M。 =(m,…m 1) 表示 m, =OCC 的 所 有 网 格 单元 , {M,} 


因此 ， 针 对 ORB-SLAM2 存在 不 


能 够 生成 用 于 


图 点 以 及 姿态 
网 格 地 图 。 


导航 和 路 径 规 划 的 地 图 的 缺点 ， 利 用 关键 帧 、 地 
x 生成 可 用 于 机 器 人 路 径 规 划 和 导航 的 2D 占用 


1 ， 建立 逆 传 感 器 模型 


移动 机 器 人 处 在 未 知 环境 中 


噪声 和 不 确定 


息 数 据 后 ， 


通过 自身 的 传感器 建立 考虑 


ee (sensor model ， SM) 。 


因素 的 概率 分 布 模型 来 估计 外 部 环境 ， 这 个 模型 
在 观测 到 外 部 环境 信 
过 这 些 数据 建立 外 部 环境 地 图 的 模型 称 做 逆 传 感 


器 模型 (inverse sensor model，ISM ) 。 


在 建立 ISM 模型 前 ， 需 要 做 适当 


当 的 马尔 可 夫 (Markov) 假 


假设 1: 地 图 网 格 间 相互 独立 ; 
假设 2: 传感器 观测 数据 时 引入 的 噪声 为 高 斯 噪声 。 
Markov 假设 对 于 ISM 模型 是 合理 的 ， 因 为 不 存在 因果 关 


系 的 占 ) 


] 状 态 不 同 的 单元 格 , 并且 从 工程 的 较 大 来 看 也 合理 的 
此 产生 的 模型 是 足够 完成 用 于 应 用 中 所 需要 的 任务 范围 ， 同 


时 ， 零 阶 Markov 


恨 设 的 计算 简单 ， 而 且 人 允许 发 展 为 灵活 的 感 


知 系统 。 

ISM 模型 的 目的 是 用 传感器 观测 数据 来 表示 占用 网 格 地 图 
单元 格 是 否 被 占用 的 概率 。 从 传感器 的 角度 分 析 ， 网 格 单元 征 
收 与 障碍 物 间 的 关系 都 可 以 用 一 个 概率 值 来 表示 其 是 否 被 占用 
的 三 进 制 状态 。 在 网 格 地 图 中 ，m, 表示 其 相应 网 格 单元 是 否 被 
5 用 的 随机 变量 ， 其 中 OCC 表示 占用 ，EMP 表示 空闲 ， 


估计 得 到 。 


这 个 模型 是 有 


Sl 


需要 注意 的 是 


因此 每 个 单元 格 的 是 否 被 占用 的 概率 可 以 通过 传感器 观测 数据 
在 构建 一 个 机 器 人 环境 地 图 时 ， 
阶段 : a) 利 用 随机 传感器 模型 对 传感器 观测 范 上 车 


这 

实际 距离 ，b) 用 传感器 观测 数据 更 新 网 格 单元 的 状态 。 
为 了 确定 如 何 通 过 传感器 观测 数据 来 估计 占用 网 格 地 图 单 
的 状态 ， 对 于 每 个 单 


并 不 一 致 ， 因 为 后 者 隐 
在 一 起 ， 换 而 言 


p(m=OCC)+p(m = EMP)=1 (1) 


会 涉及 到 两 个 处 理 
r 进行 解释 ， 


p(r|z) 的 概率 分 布 函数 定义 的 ，z 是 被 检测 到 的 


表示 所 有 地 图 网 格 单元 集合 。 同 理 可 得 
plrlm,= EMP)= 
5 (p(rlm =EMP,M, )xp(M, |m=EMP)) ©®) 
fm 


m, 


式 (4) (5) 中 p(M, |m) 的 概率 有 单元 格 的 先 验 概率 决 


m; 


定 ， 选 择 用 最 大 炳 的 先 验 ， 可 能 会 出 现 两 种 状态 概率 相等 的 情 
况 : 
p(m =0CC)=p(m = EMP)=, 
为 了 更 好 地 陈述 ISM 模型 ， 首 先 考 虑 理想 传感器 。 假设 其 


概率 分 布 函数 为 p(r|z)=6(r—z); 这 里 5 是 Kronecker delta， 
此 时 ,可 得 理想 ISM 模型 函数 g(/) 为 方程 2) 的 封闭 解 , 且 g(7) 
为 


0 a 
2 
L L 
1 <r<zt+ (6) 
8(r)=11 -FSr<z+s 
0.5 else r>0 


其 中 : T 表示 传感器 观测 范围 ; L 为 传感器 观测 的 缓冲 区 
宽度 ， L 大 小 为 网 格 单元 两 个 角 之 间 的 对 角 线 距离 。 在 


义 | 
NE 


< 区 间 g(x) =0 表 示 没有 障碍 物 ， rt 区 间 


g(r)=1 表 示 有 障碍 ， else +r >0 区 间 g(r)=0.5 表示 传感器 不 能 


够 观测 区 域 ， 即 未 知 区 域 。 注 意 ， 一 个 单元 的 中 心 用 于 计算 伟 
感 器 的 距离 ， 这 个 距离 用 于 评估 传感器 模型 的 更 新 值 。 然 而 z 
的 峰值 可 能 完全 错过 了 ， 如 果 单 元 格 的 中 心 有 一 个 从 z 轻微 的 
偏 移 量 。 虽 然 可 以 从 单元 格 边界 用 积分 找到 的 平均 价值 ， 但 因 
为 处 理 许多 单元 格 和 许多 测量 光束 这 种 方法 计算 过 于 昂贵 。 所 
以 ， 引 入 了 一 个 参数 L， 它 表示 一 个 r 值 的 频带 ， 它 接收 到 与 
肯定 占据 的 概率 相对 应 的 概率 。 在 理想 ISM 模型 函数 g (7) 中 


j 贝 叶 斯 法 则 ; 


的 网 格 单元 m 应 | 
p(m,=OCC|r) 
_p(r|lm=0OCC)p(m,=0OCC) (2) 

2 P(r lm) pm) 

, 式 (2) 中 的 p(r|m) 与 传感器 模型 中 的 p(x|z) 

含 地 将 范围 的 读 取 与 单个 物体 表面 联系 

之 ， 传 感 器 模型 可 重 写 为 


没有 把 概率 值 1 指定 为 + 上 , 而 是 在 r 附近 的 一 
这 是 为 了 确保 障碍 物 落下 的 单元 接收 到 的 值 为 1。 
实践 中 的 ISM 模型 是 由 理想 条 件 下 的 逆 传 感 嚣 模型 和 高 
斯 噪声 进行 卷 积 得 到 的 。 通 过 理想 逆 传 感 嚣 模型 g(x) 与 高 斯 品 
声 模型 f(x) 卷 积 能 够 得 到 实践 中 的 ISM 模型 : 


-(r—0) 


1 -3 
yp 


组 宽度 L aE 
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(f*g)(r)| g(r) f(r-r)dr (7) 

从 g(r) 的 表达 式 能 够 看 出 ， 其 为 分 段 函 数 ，g(r) 与 (7) 
进行 卷 积 时 ， 可 以 进行 分 段 卷 积 ， 重 写 卷 积 方程 为 

(f *g)(r)=KF (a,b) (8) 

这 里 (a,b) 为 观测 值 z 和 范围 1 上 的 间隔 ，ke{0,0.5,1} 是 


p(m) 的 取 值 ， 其 与 网 格 单元 状态 变量 的 概率 是 一 致 的 。 可 以 
得 到 
i 09) 
F(ab)=— pz,e 2 
式 (9) 中 ,， 令 wx= 全 ”， 可 以 重 写 为 
"oF 
-1 ps 。 
PO du (10) 
为 了 方便 计算 ， 用 误差 函数 表示 式 (10) : 
1 r-b 1 r—a 
F(a,b 1 (11) 
We 37( le 
其 中 : 误差 函数 exftx) 为 
2 fx 
= 一 | cd (12) 
erf (x) he 1 


于 (a,b) 为 观测 值 z 和 范围 上 的 间隔 ,为 了 方便 ISM 模 
型 的 推导 ， 假 设 a=-oo， 所 以 可 重新 定义 (a,b) : 


[ll 


(13) 


1 r-b 1 
dl | 2 
根据 g(x) 的 分 段 区 间 与 f(x) 进行 卷 积 积 分 可 得 


jeu er] 
2 2 2 


1058 (z+ 人 7 | 
2 


(eaO)=orl miz 


1 一 和 
-er 
高 斯 品 f(7) 与 理想 ISM 模型 g(r) 卷 积 的 到 实际 中 应 用 
的 ISM 模型 ， 其 卷 积 前 后 图 形变 化 如 图 1 所 示 。 
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0.8 
R06 
E 
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02 
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rm) 


图 1 ISM 模型 建立 过 程 


2 ”建立 网 格 地 图 模型 


网 格 地 图 是 把 环境 划分 为 许多 


个 等 尺度 的 单元 格 ， 通 过 网 


格 单元 表示 部 分 环境 并 存储 该 单元 格 是 否 有 障碍 物 的 信息 ， 即 


该 单元 格 状 态 是 占用 、 
表示 出 障碍 物 的 边界 ， 


bb 


空闲 还 是 未 知 。 在 占用 情况 下 ， 它 能 
能 够 用 于 路 径 规划 和 机 器 人 导航 。 在 空 


闲 情 况 


器 不 能 够 观测 到 该 单元 格 状 ; 
用 网 格 地 图 的 / 


5 m 等 。 


表示 该 单元 格 没有 障碍 物 ， 而 未 知情 况 下 则 表示 传 感 
态 ， 即 是 否 有 障碍 物 情况 未 知 。 占 
' 度 问题 是 通过 其 分 状 率 表示 的 , 如 用 1 cm 表示 
网 格 地 图 中 ， 通 过 数值 0、1、0.5 的 概率 来 表 


在 占用 


示 其 单元 格 的 状态 ， 其 中 0 表示 空 尊 ，1 表示 被 占用 ，0.5 则 表 


示 状 态 未 知 。 


不 境 数 据 时 会 引入 噪声 和 不 确定 性 


F 在 传感器 观测 外 界 ; 


因素 ， 所 以 需要 把 噪声 和 不 确定 性 因素 的 影响 加 入 到 网 格 地 图 


模型 中 。 


其 状态 可 以 用 二 


如 果 用 m, 表示 地 图 中 第 i 个 单元 格 ， 


如 


变量 表示 占用 或 空间 )〉 。 理 想 情 况 


» 从 时 间 1: t 


进 制 占用 


ww 
的 后 验 概率 可 以 表示 为 


p(m Zi a) (15) 


对 于 传感器 的 观测 数据 z 以 及 对 应 机 器 人 姿态 x， 假 设 其 


都 在 世界 坐标 系 下 ， 所 以 地 图 单元 格 m 的 后 验 概率 又 可 写 做 : 


plm| zs) (16) 


如 果 把 地 图 m 划分 成 i 个 相同 尺度 的 网 格 ， 每 个 网 格 的 下 


标 索 引 为 1， 有 m={m} 。 根 
p(m,=1) 表示 被 占 


居 网 格 单元 是 否 被 占用 
j， P(m =0) 表示 空间，p(m, =0.5) 表示 


多 上 + 


— 


未 知 状态 ， 其 中 : 
plm =0)=p(m)=1 pl(m,=1) (17) 
如 果 有 1 000 个 单元 格 ， 那 么 地 图 就 有 ?too 种 可 能 ， 所 以 


对 于 实际 建 图 来 说 ， 这 并 不 是 一 个 切实 可 行 的 方案 。 


根据 前 面 


所 做 的 Markov 假设 ,每 个 单元 格 概率 p(m | zs, ) 是 统计 独立 的 ， 
那么 N 个 独立 的 网 格 单元 概率 可 表示 为 


随 着 时 间 的 推移 ， 把 第 i 


Pp(mi,m,,..., (18) 


N 
mn | zx ) = [pO | zz) 
i 


个 单元 格 被 占用 


与 否 的 概率 加 入 


录用 稿 
到 地 图 m 的 概率 分 布 中 ， 最 终 实现 地 图 的 不 断 更 新 。 为 了 实现 
这 一 机 制 ， 采 用 二 进 制 由 叶 斯 滤波 器 算法 。 对 于 静态 环境 ， 伟 
感 器 观测 数据 与 地 图 单元 格 间 是 相互 独立 的 ， 应 用 贝 叶 斯 法 则 
可 得 


p(m, | Zi Xs ) 


We pz |m, Tip Xa) PCA Zi Xs ) 
plz | zi Xs) 


Morioy pl(z, | mi, x ) pm | ee 


(19) 
pl(z, | Zs Xi ) 
有 Bayes 法 则 可 得 : 
Rn 四 
带 入 方程 (19)， 所 以 plm, | zoXy) 可 化 为 
pm, | za) 
ie p(m|z,%)p(z | x) pm | zi Xi) 
p(m, | x)p(z | Ze i) 
wo plm Lao) pp(m lot) 
pm)p(z | zi X) 
对 于 概率 p(m | Zi) 应 用 相同 的 原理 可 得 
p(m| zx 
p(m| to) pw) pm la a) (22) 
p(m)plz, | Zi Xi ) 
为 了 减少 无 味 的 计算 ， 把 式 (21) (22) 作 商 ， 化 简 可 得 
plm | zis) 
p(m, | zz] 
plm;|z,%) pz | x) pm 2 
= us p(m;)pl(z, | zis Ns) 
二 p(m|z,%)p(z, [x) p(n | zu a) 
pm) plz | zn) 
加 plm|z,%)p(m | zu) Pp(m;) 
p(m, | zx )P(m, | zy Xs ) pm,) 
pm|z,%) plm|z om) 1-p(m,) (23) 
1—p(m|z,x)1— pm zz) plm) 
通过 对 式 (23) 分 析 可 知 ，_2(m |z, 交 ) 为 地 图 单元 格 吉 
1- pl(m;|z,x%) 
在 t 时 刻 的 后 验 分 布 ，_B(ma| zu-xu- 为 递归 项 ， 是 mn 在 
1— p(m, | zi, X11) 
中 时刻 地 图 的 后 验 分 布 ， -一 是 地 图 的 先 验 分 布 。 
pm 
为 了 避免 概率 在 0 或 1 附近 数值 的 不 稳定 ， 通 常用 Logit 


函数 对 式 (23) 取 对 数 ， 可 得 


lo 
{i 


p(m, | Zi Xs ) Jj- 
—p(m; | Zijs Xs) = 


pm |z,,%,) 


p(m, | ZN ) | 


令 L(m, | Zh) 二 os 


器 模型 (ISM) 函 
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+lo 
eT 


pm | zu 


: | ol 
plm,| es 


pm | zi Xis) 
1— p(m; zx) 
L(m |z,, xX)=L(m |z,%)+L(m |zi i, Xs 1) 
—L(m,) (25) 
el sl le rite 
数 ，L(m | zx) 为 前 一 时 刻 的 ISM 函数 ， 


ee | (24) 
pl(m) 


]" 式 24 可 简化 为 


即 递归 项 ， ZL(m ) 是 地 图 的 先 验 信息 。 为 了 更 加 清晰 地 表达 网 
格 地 图 构建 机 制 ， 重 写 上 式 为 


[i= TSM (mz,X,) + ls -ho (20) 
根据 上 面 的 占用 网 格 地 图 算法 的 推导 ， 更 为 清晰 地 算法 表 
达 为 : 
/*Initialization*/ 


for all grid cells m, do 
li =log(p(m)) -log(1— p(m)) 
endfor 
/*grid calculation using logit function */ 
for all time steps 七 from 1to T do 
for all grid cells m, in the perceptual range of pe do 
L; =; + TISM (m,,z,,%, )—io 
endfor 
endfor 


/*recovery of occupancy probabilities*/ 


for all grid cells m, do 


plm|z,%)=1- 
2 
endfor 
在 时 间 t 时 刻 ， 机 器 人 的 姿态 为 x, ， 传 感 器 的 观测 数据 为 
z，， 当 前 所 有 网 格 单元 为 fm } ， 每 个 单元 格 的 后 验 概率 为 
P( | zy)， 按照 最 大 后 验 概率 (MAP) 建 图 ， 有 
m* =argmax P(Z zy 2, | 122) 
i | |m,x,) (27) 
3 ”ORB-SLAM2 生成 网 格 地 图 模型 


ORB-SLAM2 生成 网 格 地 图 


是 通过 在 ROS 中 发 布 


ORB-SLAM2 中 生成 的 所 有 关键 帧 和 地 图 点 以 及 机 器 人 姿态 


x ， 然 后 订阅 
和 机 器 人 姿态 


多 


到 。 其 算法 流程 如 图 


其 发 布 信息 给 ISM 模型 ,作为 传感器 观测 数据 = 
x,， 进 而 通过 网 格 地 图 模型 生成 所 需要 的 网 格 地 
2 所 示 。 
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=0 =1 =0.5 
Grid map | | | 
unknown 


free occupany 


法 框图 


图 2 ORB-SLAM2 生成 grid map 


4 ”实验 


4.1 上 值 的 选取 


ISM 模型 的 变化 。L 值 对 ISM 模型 影响 如 图 3 所 示 。 


00 05 10 15 20 25 30 35 40 
nm) 


图 3 工 值 对 ISM 模型 影响 


在 讨论 工 值 对 ISM 影响 时 ， 采 用 固定 变量 的 策略 。 首 先 ， 
固定 z 值 和 固定 的 高 斯 噪声 模型 ， 通 过 改变 工 值 的 大 小 ， 观 测 


通过 对 图 3 的 分 析 可 以 看 出 ， 随 着 工 的 取 值 的 不 断 变 大 ， 
ISM 模型 网 格 单元 概率 不 断 地 增 大 ， 这 说 明 随 着 工 的 增 大 ,将 


会 有 更 多 的 网 格 单元 被 判断 为 有 障碍 物 ， 与 之 相反 ， 
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从 图 4 可 以 看 出 , 不 同 的 o 值 对 ISM 模型 的 影响 


期 和 


为 奸 


。 随 着 


值 的 不 断 变 大 ， 表 示 不 确定 性 因素 和 噪声 的 影响 越 来 越 大 ， 随 
之 而 来 的 是 ISM 模型 的 网 格 单元 的 后 验 概率 越 来 越 小 , 这 表示 


将 会 有 更 多 的 网 格 单元 被 判断 为 空间 ， 然 而 事实 并 非 如 此 。 


图 5 z 值 对 ISM 模型 影 
对 于 不 同 观测 范围 z， 同 样 会 影响 ISM 模型 (图 
过 对 图 5 的 分 析 可 以 看 出 ， 随 着 观测 范围 


bey 


对 地 图 网 格 单元 的 判断 也 就 越 来 越 不 准确 。 
4.3 室内 实时 实验 


:也 


5) 。 通 


z 的 不 断 增 大 ， 机 器 
人 的 观测 范围 会 越 来 越 大 ， 同 时 在 越 来 越 大 的 范围 内 ， 


机 器 人 


对 于 室内 的 实时 测试 选取 在 在 实验 室内 和 走廊 。 所 用 的 实 


验 设备 是 一 个 XBOX360 的 深度 相机 和 Logitech 的 USB 摄像 


机 。 
首先 用 


USB 摄像 机 作 实验 室 室 内 实验 。 


— 


通过 实验 可 以 看 


出 ， 用 单 目 相机 做 实验 时 ， 在 生成 的 网 格 地 图 中 ， 对 障碍 物 的 
标注 不 够 清晰 ， 而 且 对 于 实验 室 中 轴线 上 的 办 公 桌 等 障碍 物 无 
法 标注 出 来 。 这 是 由 于 单 目 相机 是 没有 尺度 信息 的 ， 在 生成 地 


网 格 地 图 


中 的 空闲 的 单元 格 将 会 减少 ， 当 工 的 取 值 超过 一 定 的 界限 是 ， 
会 出 现 大 量 的 误 判 ， 即 现实 环境 中 本 没有 障 但 物 的 地 方 会 被 误 


判 为 有 障碍 物 。 通 过 实验 得 到 ， 当 工 的 取 值 为 网 格 单元 对 


的 长 度 时 ， 出 现 的 误 判 几率 最 小 。 
4.2 不 确定 性 因素 和 观测 范围 z 的 影响 


有 线 


于 在 传感器 的 观测 过 程 中 会 引入 噪声 和 一 些 不 确定 性 因 


素 ， 而 这 些 噪声 和 不 确定 因素 同样 会 对 地 图 的 构建 造成 影响 ， 


首先 讨论 加 入 不 确定 性 因素 的 ISM 模型 的 影响 。 
模型 影响 图 4 所 示 。 
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图 4 ”oo 值 对 ISM 模型 影响 


o 值 对 ISM 


图 点 云图 的 过 程 中 会 把 中 间 的 关键 帧 、 特 征 点 等 信息 错误 地 划 
分 到 实验 室 的 边缘 上 。 这 导致 了 在 生成 网 格 地 图 的 过 程 中 不 能 


够 成 功 地 标注 出 实验 室 中 负 
格 地 图 。 真 实 室内 环境 和 单 
示 。 


线 上 的 障碍 物 ， 最 终生 成 错误 的 网 
相机 生成 室内 网 格 地 图 如 图 6 所 


相机 生成 室内 网 格 地 图 
为 了 克服 单 目 相机 没有 尺度 信息 致使 生成 错误 的 网 格 地 


图 6 真实 室内 环境 和 单 


图 ，) 


具有 尺度 信息 的 RGB-D 相机 做 室内 实验 。 通 过 RGB-D 
实验 结果 与 单 目 相 机 的 实验 结果 作对 比 可 以 发 现 ， 用 


RGB-D 


相机 产生 的 网 格 地 图 相 比 于 单 目 相 机 有 两 个 优点 : aJRGB-D 相 
机 具有 尺度 信息 ， 其 生成 的 地 图 点 云图 能 够 正确 地 生成 网 格 地 
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图 ， 对 于 室内 中 轴线 上 的 障碍 物 也 能 够 标注 出 来 ;，b) 其 生成 的 


网 格 地 图 相 比 于 单 目 相机 生成 的 网 格 地 图 更 加 清晰 ， 对 于 室内 
的 障碍 物 能 够 清晰 地 显示 出 来 ， 而 且 能 够 标准 出 障碍 物 的 相对 
位 置 ， 并 不 像 单 目 相 机 那样 把 所 以 的 障碍 物 都 归 一 于 一 个 平面 
上 。 图 7 为 RGB-D 相机 的 运动 轨迹 点 云图。 从 图 中 能 够 看 到 


格 地 图 是 参差 不 齐 的 


相机 运动 一 周 其 生成 的 室内 环境 稀 疏 点 云图 ， 即 其 运动 轨迹 。 
图 8 为 RGB-D 相机 在 其 运动 过 程 中 生成 的 网 格 地 图 。 图 中 网 
， 这 是 因为 如 图 6 


2 


的 真实 场景 所 示 ， 由 


于 室内 存在 桌 灌 等 不 规则 障碍 物 造 成 的 。 


RGB-D 运动 轨迹 点 云图 


图 8 RGB-D 相机 生成 室内 网 格 地 图 


走廊 场景 和 运动 轨迹 点 云图 如 图 9 所 示 。 在 完成 室内 小 场 
景 的 实验 后 ， 用 RGB-D 相机 在 走廊 做 大 场景 实验 (图 10) 。 


通过 实验 结果 可 以 看 


上 ， 对 于 走廊 环境 ， 生 成 的 网 格 地 图 能 


清晰 看 到 走 亡 两 边 的 墙壁 和 实验 室 的 门槛 等 事物 ， 其 中 突出 较 


大 部 分 非 走廊 旁边 的 


电梯 


标注 出 走廊 中 的 障碍 物 。 


口 ， 能 够 很 好 地 反映 出 走廊 环境 ， 


图 9 走廊 场景 和 运动 轨迹 点 云图 
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图 10 RGB-D 相机 走廊 网 格 地 图 


结束 语 


针对 以 往 视觉 SLAM 系统 生成 地 图 不 能 用 于 机 器 人 导航 


和 路 径 规划 的 缺点 ， 本 文 在 ORB-SLAM2 的 基础 上 ， 提 出 一 种 
网 格 地 图 实时 构建 算法 。 该 算法 建立 了 适合 用 于 视觉 SLAM 的 
逆 传 感 器 模型 (ISM) ， 并 对 模型 进行 了 定性 分 析 ， 确 定 了 切 


实 可 用 的 ISM 模型 ， 详 细 推导 了 网 格 地 图 构建 机 制 ， 并 利用 算 


法 让 


EE 图 清晰 地 解释 了 ORB-SLAM2 生成 网 格 地 图 的 具体 流程 。 
通过 实验 ， 对 单 目 相机 和 RGB-D 相机 的 实验 结果 进行 分 析 ， 


实验 表明 ISM 模型 和 网 格 地 图 算法 的 有 效 性 以 及 本 文 算法 具 
有 较 强 的 实用 性 ， 能 够 实时 生成 用 于 机 器 人 导航 和 路 径 规划 的 
地 图 。 
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